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Dynamics and Control of Quadrotor UAVs Transporting a Rigid Body 

Connected via Flexible Cables 

Farhad A. Goodarzi and Taeyoung Lee* 


Abstract — This paper is focused on the dynamics and control 
of arbitrary number of quadrotor UAVs transporting a rigid 
body payload. The rigid body payload is connected to quadro- 
tors via flexible cables where each flexible cable is modeled 
as a system of serially-connected links. It is shown that a 
coordinate-free form of equations of motion can be derived 
for arbitrary numbers of quadrotors and links according to 
Lagrangian mechanics on a manifold. A geometric nonlinear 
controller is presented to transport the rigid body to a fixed 
desired position while aligning all of the links along the vertical 
direction. Numerical results are provided to illustrate the 
desirable features of the proposed control system. 

I. INTRODUCTION 

There are various applications for aerial load transporta¬ 
tion such as usage in construction, military operations, emer¬ 
gency response, or delivering packages. Load transportation 
with the cable-suspended load has been studied traditionally 
for a helicopter [1], [2] or for small unmanned aerial vehicles 
such as quadrotor UAVs [3], [4], [5]. 

In most of the prior works, the dynamics of aerial trans¬ 
portation has been simplified due to the inherent dynamic 
complexities. For example, it is assumed that the dynamics 
of the payload is considered completely decoupled from 
quadrotors, and the effects of the payload and the cable are 
regarded as arbitrary external forces and moments exerted to 
the quadrotors [6], [7], [8], thereby making it challenging 
to suppress the swinging motion of the payload actively, 
particularly for agile aerial transportations. 

Recently, the coupled dynamics of the payload or cable has 
been explicitly incorporated into control system design [9]. 
In particular, a complete model of a quadrotor transport¬ 
ing a payload modeled as a point mass, connected via a 
flexible cable is presented, where the cable is modeled as 
serially connected links to represent the deformation of the 
cable [10]. In another distinct study, multiple quadrotors 
transporting a rigid body payload has been studied [11], 
but it is assume that the cables connecting the rigid body 
payload and quadrotors are always taut. These assumptions 
and simplifications in the dynamics of the system reduce the 
stability of the controlled system, particularly in rapid and 
aggressive load transportation where the motion of the cable 
and payload is excited nontrivially. 

The first distinct contribution of this paper is presenting 
the complete dynamic model of an arbitrary number of 
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Fig. 1. Quadrotor UAVs with a rigid body payload. Cables are modeled 
as a serial connection of an arbitrary number of links (only 4 quadrotors 
with 5 links in each cable are illustrated). 

quadrotors transporting a rigid body where each quadrotor 
is connected to the rigid body via a flexible cable. Each 
flexible cable is modeled as an arbitrary number of serially 
connected links, and it is valid for various masses and 
lengths. A coordinate free form of equations of motion is 
derived according to Lagrange mechanics on a nonlinear 
manifold for the full dynamic model. These sets of equations 
of motion are presented in a complete and organized manner 
without any simplification. 

Another contribution of this study is designing a con¬ 
trol system to stabilize the rigid body at desired position. 
Geometric nonlinear controllers presented in the author’s 
previous study is utilized [12], [13], [14], and they are gen¬ 
eralized for the presented model. More explicitly, we show 
that the rigid body payload is asymptotically transported into 
a desired location, while aligning all of the links along the 
vertical direction corresponding to a hanging equilibrium. 

The unique property of the proposed control system is 
that the nontrivial coupling effects between the dynamics of 
rigid payload, flexible cables, and multiple quadrotors are ex¬ 
plicitly incorporated into control system design, without any 
simplifying assumption. Another distinct feature is that the 
equations of motion and the control systems are developed 
directly on the nonlinear configuration manifold intrinsically. 
Therefore, singularities of local parameterization are com¬ 
pletely avoided to generate agile maneuvers of the payload 
in a uniform way. In short, the proposed control system is 



particularly useful for rapid and safe payload transportation 
in complex terrain, where the position of the payload should 
be controlled concurrently while suppressing the deformation 
of the cables. 

This paper is organized as follows. A dynamic model 
is presented and the problem is formulated at Section II. 
Control systems are constructed at Sections III and IV, which 
are followed by numerical examples in Section V. Due to the 
page limit, parts of proofs are relegated to [15]. 

II. Problem Formulation 

Consider a rigid body with mass mo E M and moment 
of inertia Jo E M 3x3 , being transported with arbitrary n 
numbers of quadrotors. The location of the mass center of 
the rigid body is denoted by xo EM 3 , and its attitude is given 
by Ro E SO(3), where the special orthogonal group is given 
by S0(3) = {R e R 3x3 | R T R = I,det(R) = 1}. Figure [I] 
illustrates the system with an inertial frame. We choose an 
inertial frame {ei, e 2 ,e 3 } and body fixed frame {&i, 62 , 63 } 
attached to the payload. We also consider a body fixed frame 
attached to the i-th quadrotor {b \ i , 62 ., 63 .}. In the inertial 
frame, the third axes <33 points downward with gravity and 
the other axes are chosen to form an orthonormal frame. 

The mass and the moment of inertia of the i-th quadrotor 
are denoted by E R and Ji E M 3x3 respectively. The 
cable connecting each quadrotor to the rigid body is modeled 
as an arbitrary numbers of links for each quadrotor with 
varying masses and lengths. The direction of the j- th link 
of the i-th quadrotor, measured outward from the quadrotor 
toward the payload is defined by the unit vector E S 2 , 
where S 2 = {q E M 3 | \\q\\ = 1}, where the mass and length 
of that link is denoted with and Uj respectively. The 
number of links in the cable connected to the i-th quadrotor 
is defined as n*. 

The configuration manifold for this system is given by 
S0(3) x M 3 x (S0(3) n ) x (S 2 )£-i"l The i-th quadrotor 
can generate a thrust force of —fiRie 3 E M 3 with respect to 
the inertial frame, where fi E M is the total thrust magnitude 
of the i -th quadrotor. It also generates a moment Mi E M 3 
with respect to its body-fixed frame. Throughout this paper, 
the two norm of a matrix A is denoted by ||A||. The standard 
dot product is denoted by x • y = x T y for any x, y E M 3 . 

A. Lagrangian 

The kinematics equations for the links, payload, and 
quadrotors are given by 

Qij = kJij X q^ = uJij qij , (1) 

Ro = Ro&o, (2) 

Ri = Ri&i, (3) 

where ujij E M 3 is the angular velocity of the j- th link in 
the i-th cable satisfying q^ • = 0. Also, D 0 E M 3 is the 

angular velocity of the payload and E M 3 is the angular 
velocity of the i-th quadrotor, expressed with respect to the 
corresponding body fixed frame. The hat map • : M 3 -A so (3) 
is defined by the condition that xy = x x y for all x, y EM 3 , 


and the inverse of the hat map is denoted by the vee map 

V : so(3) M 3 . 

The position of the i-th quadrotor is given by 

rii 

Xi = X 0 + RoPi - ^2 haQia, (4) 

a= 1 

where pi E M 3 is the vector from the center of mass of the 
rigid body to the point that i -th quadrotor is connected to 
rigid body via the cable. Similarly the position of the j-th 
link in the cable connecting the i-th quadrotor to the rigid 
body is given by 

rii 

%ij ^0 H - R0Pi ^ ^ liaQia • (5) 

a=j+ 1 

We derive equations of motion according to Lagrangian 
mechanics. Total kinetic energy of the system is given by 

-j n rii ^ -\ n 

T =-TOo||±o || 2 + V V 2 mij Ill'll 2 + 2 D^ll^ll 2 

i=lj=l i= 1 

1 n 1 

+ - • J%^i A -Dq • JoD 0 . (6) 

i= 1 

The gravitational potential energy is given by 

n n rii 

V = -m 0 ge 3 ■ x 0 - ^ rn t ge ?I ■ Xi - EE rriijge3 ■ Xij, 

(7) 

where it is assumed that the unit-vector e 3 points downward 
along the gravitational acceleration as shown at Figure [T] 
The corresponding Lagrangian of the system is L = T — V. 

B. Euler-Lag range equations 

Coordinate-free form of Lagrangian mechanics on the two- 
sphere S 2 and the special orthogonal group SO(3) for various 
multibody systems has been studied in [16], [17]. The key 
idea is representing the infinitesimal variation of Ri E SO(3) 
in terms of the exponential map 

5Ri = Riexp(efji) = Rify 5 ( 8 ) 

de e=0 

for r\i E M 3 . The corresponding variation of the angular 
velocity is given by = fji A x iji. Similarly, the 
infinitesimal variation of q^ E S 2 is given by 

$Qij = x qij , (9) 

for &j E M 3 satisfying ^ • q^ = 0. This lies in the tangent 
space as it is perpendicular to qi. Using these, we obtain the 
following Euler-Lagrange equations. 



Proposition 1: By using the above expressions, the equa¬ 
tions of motion can be obtained from Hamilton’s principle: 

n rti n 

Mt%o — EE Mftij lij Qij ^ MiTRopi&o 

i=l j=l i=1 

n n 

= M T ge 3 + ^ —fiRie 3 — ^ M iT Ro&oPi, (10) 

i= 1 i=l 

n n rii 

Jo&o + MiTpiR^xo — EE MoijlijPiR 0 ijij 

i=1 i=1 j=1 

n 

= E PlR l{-fiRi?z + M iT ge 3 ) - {l 0 J 0 n 0 , ( 11 ) 

i= 1 

rii 

'y ^ MpjjIjkQjjQjk MoijQijXo + Moijq—RoPi&o 

k= 1 

= MoijffijRoCllpi - qijiMoijges - fiRie s ), ( 12 ) 

x = Mi. (13) 

Here the total mass Mt of the system and the mass of the 
2 -th quadrotor and its flexible cable M iT are defined as 

n rii 

Mt = 77i o + E Mit , ^ wiij + rrii f (14) 

»=i j=i 

and the constants related to the mass of links are given as 


and the sub-matrix N qqi G M 3n * x3n * is given by 


N • — 

L 'qqi — 

—Moiiluls Moi2li2q_i2 
Mo2lhlQil —Mo22h2h 

MoinihmQim 

Mo2nihmQi ni 


_MomilnQ.ii Mo ni 2h2Qi2 ’ 

Mo nini li ni I 3 

( 20 ) 

The P G R Dx matrix is 



P = [P, a ■ -Fho, Plj, P‘2;j ■ •• 

• , Pnjf, ( 21 ) 


and sub-matrices of P matrix are also defined as 

n n 

Rx o = M T ge 3 + ^ -fiRie 3 - ^ M iT Ro&oPi , 

n 

Pq 0 = —&oJo^o + ^ (M iT ge 3 — fiRie 3 ), 

i=l 

Pij = Qiji fiRie 3 + M^ijgcf) + MoijqijRoCl^pi 
+ Moij\\qij\\ 2 qij . 

Proof: See Appendix |A| ■ 

These equations are derived directly on a nonlinear manifold 
without any simplification. The dynamics of the payload, 
flexible cables, and quadrotors are considered explicitly, and 
they avoid singularities and complexities associated to local 
coordinates. 


j-i 

M 0i j = rrij + y~+ a , (15) 

a=l 

The equations of motion can be rearranged in a matrix form 
as follow 

NX = P (16) 

where the state vector X G R Dx with Dx =6 + 3 Y^i=i n i 
is given by 

X = [xq, Qij : Q2j 5 5 (/nj] 5 ( 12 ) 


III. CONTROL SYSTEM DESIGN FOR SIMPLIFIED 
DYNAMIC MODEL 

A. Control Problem Formulation 

Let xo d Gl 3 be the desired position of the payload. The 
desired attitude of the payload is considered as Ro d = / 3 X 3 , 
and the desired direction of links is aligned along the vertical 
direction. The corresponding location of the +th quadrotor 
at this desired configuration is given by 

rij 

x i d = x 0 d + Pi ~ E liae 3' (22) 


and matrix N G M Dx x Dx is defined as 


Mt^3 


N, 0 i 

N, 0 2 •• 

N 

^xo n 


Jo 

N n 0 i 

N^ q 2 " 

^Qon 

Nlxo 

N 100 

N w i 

0 

0 

N 2^ 0 

N2Q 0 

0 

N qq2 

0 

_ N tixq 

N n ^ 0 

0 

0 

-Nggn 


where the sub-matrices are defined as 

n 

= - + M iT RoPi; = M^ ono , 

i =1 

Naio* = [MonlnIs) M()i2li2l3i 5 M()i ni li ni I^\ 
-Nfio* = [MonlupiRQ , MofelfePiRo Moi ni l ini 

= [MonQn’> Moi2qi2 5 * * * ? Mq imQim\ ? 
= [Monqi^Ropij MonQ^Ropi, 5 -^JoiniQim-^ 


<2=1 

We wish to design control forces and control moments Mi 
of quadrotors such that this desired configuration becomes 
asymptotically stable. 

B. Simplified Dynamic Model 

Control forces for each quadrotor is given by —fiR ^3 for 
the given equations of motion ( [TO] ), ( pT) , ( [12] ), ( [13] ). As such, 
the quadrotor dynamics is underactuated. The total thrust 
magnitude of each quadrotor can be arbitrary chosen, but the 
direction of the thrust vector is always along the third body 
fixed axis, represented by Rie 3 . But, the rotational attitude 
dynamics of the quadrotors are fully actuated, and they are 
not affected by the translational dynamics of the quadrotors 
or the dynamics of links. 

p R t ] Based on these observations, in this section, we simplify 
z 0 ’ the model by replacing the —fiRie 3 term by a fictitious 
control input Ui G M 3 , and design an expression for u to 
o/y T , asymptotically stabilize the desired equilibrium. In another 
(19) words, we assume that the attitude of the quadrotor can be 






instantaneously changed. The effects of the attitude dynamics 
are studied at the next section. 

C. Linear Control System 

The control system for the simplified dynamic model is 
developed based on the linearized equations of motion. At 
the desired equilibrium, the position and the attitude of the 
payload are given by xo d and Rq = J 3 , respectively, where 
the superscript * denotes the value of a variable at the desired 
equilibrium throughout this paper. Also, we have qtj = e 3 
and R* =/ 3 . In this equilibrium configuration, the control 
input for the i-th quadrotor is 


where the sub-matrices are defined as 

n 

M x 0 n 0 = - y ^MjTPL Mq o£Co = M^ o , 

i= 1 

M Xoi = [MonliiesC, ••• , Mo irii li ni e 3 C], 

M^ 0 = —[MoiiC T e3, Moi2C T es, ••• , Moi ni C T e 3 ], 

(27) 

= [MonC T esPi, Moi 2 C T e 3 /$i, ? Mo ini C T espi\, 

(28) 

and the sub-matrix M qqi G M 2n * x2n * is given by 


< = -/*i?*e 3 , (23) 

where the total thrust is /* = (M iT + ir jf L )g- 
The variation of xq is given by 

Sx 0 = x 0 -xo d , (24) 

and the variation of the attitude of the payload is defined as 

5Rq = RqTJo = r) 0 , 

for r]o G M 3 . The variation of can be written as 

$Qij = £ij * ^ 3i (25) 

where ^ G M 3 with ^ • e 3 = 0. The variation of ujij is given 
by SuJij G M 3 with Sw^-es = 0. Therefore, the third element 
of each of and Sooij for any equilibrium configuration 
is zero, and they are omitted in the following linearized 
equations. The state vector of the linearized equation is 
composed of C T £ij G M 2 , where C = [ei, e 2 \ G M 3x2 . 
The variation of the control input Sui G M 3xl , is given as 
Sui = Ui — u*. 

Proposition 2: The linearized equations of the simplified 
dynamic model are given by 

Mx + Gx = B Su, (26) 

where the state vector x G M Dx with D x = 6 + 2 J27= l 
is given by 

x = [feo, no,c T ^,c T ^ 2 j,■■■,c T £ nj ] , 

and 5u = [Su^, , ••• , G M 3nxl . The matrix 

M G R DxXD ^ are defined as 


Mr I3 

M zofio 

-M-CCol 

M Xo 2 * * 

-M-CCo^ 

M n 0 s 0 

Jo 

M^ 0 i 

M^ q 2 * • 


Mix, 

M mo 

M qql 

0 

0 

M 2a:o 

M 2 n 0 

0 

£ 

to 

0 



0 

0 

• M qqn _ 


^A-qqi — 


Mining 

Mullah 


Mn2li2h 

Mi22li2h 


Mimihih Mi ni 2li2l2 


M-i\m lirii ^2 
M-i2rii lirii 12 

in in in ^2 

(29) 


The matrix G G M, DxXDx is defined as 


G = 


'0 

0 

0 

0 


0 

0 

0 


0 0 0 0 
0 0 0 0 
Gi 0 0 0 

0 G 2 0 0 


0 0 0 0 0 G n 


where G^ 0 q 0 = Yn=i ^PPih and the sub-matrices G* G 

R 2 n <x 2 n < are 


Gi = diag[(—MiT - + M 0ij )ge 3 I 2 ]. 

The matrix B G M D ^ x3n is given by 


h h *" h 

Pi P2 * * * Pn 

B b 0 0 0 

0 Bb 0 0 5 

0 0 0 B b 


where B b = ^[C T e 3 , C T e 3 , • • • , C T e 3 ] T . 

Proof: See Appendix [B] ■ 

We present the following PD-type control system for the 
linearized dynamics 


Sui = - K Xi y: - K Xi ±, (30) 


for controller gains K x ., K Xi G 


1XD : 


x . Provided that (26) 


is controllable, we can choose the combined controller gains 

K x = [KlKlJ, K ± = [Kl,... KJJ € 


such that the equilibrium is asymptotically stable for the 
linearized equation ( [26] ). 











IV. CONTROL SYSTEM DESIGN FOR THE FULL 
DYNAMIC MODEL 


0.5 


The control system designed at the previous section is 
based on a simplifying assumption that each quadrotor can 
generates a thrust along any direction. In the full dynamic 
model, the direction of the thrust for each quadrotor is 
parallel to its third body-fixed axis always. In this section, 
the attitude of each quadrotor is controlled such that the third 
body-fixed axis becomes parallel to the direction of the ideal 
control force designed in the previous section. The central 
idea is that the attitude Ri of the quadrotor is controlled 
such that its total thrust direction —Rie 3 , corresponding to 
the third body-fixed axis, asymptotically follows the direction 
of the fictitious control input ui . By choosing the total thrust 
magnitude properly, we can guarantee asymptotical stability 
for the full dynamic model. 

Let Ai G M 3 be the ideal total thrust of the i-th quadrotor 
that asymptotically stabilize the desired equilibrium. There¬ 
for, we have 




(a) Payload position (xoiblue, xo d :red ) (b) Payload velocity (uoiblue, uo d :red) 
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Ai = u* + 5ui 


-K Xi x- K ±i ± + u*, 


(31) 


(c) Payload angular velocity Qq (d) Quadrotors angular velocity errors . 


where /* and u* are the total thrust and control input of 
each quadrotor at its equilibrium respectively. 

From the desired direction of the third body-fixed axis of 
the i-th quadrotor, namely 63 . G S 2 , is given by 

Ai 


b 3i = 


iwr 


(32) 


This provides a two-dimensional constraint on the three 
dimensional desired attitude of each quadrotor, such that 
there remains one degree of freedom. To resolve it, the 
desired direction of the first body-fixed axis G S 2 

is introduced as a smooth function of time. Due to the fact 
that the first body-fixed axis is normal to the third body-fixed 
axis, it is impossible to follow an arbitrary command b\ i (t) 
exactly. Instead, its projection onto the plane normal to b 3 . is t 
followed, and the desired direction of the second body-fixed 
axis is chosen to constitute an orthonormal frame [13]. More, 
explicitly, the desired attitude of the i-th quadrotor is given 
by 




(e) Payload attitude error \Pq 


(f) Quadrotors attitude errors \Eq 




(g) Quadrotors total thrust inputs R 


Ri „ = 




£>3; f>l 


(33) 


(h) Direction error e q , and angular velocity 
error e w for the links 


ll(M 2 M WbsAuW ' 

which is guaranteed to be an element of 50 (3). The desired 
angular velocity is obtained from the attitude kinematics 
equation, = ( Rf c Ri c ) y G M 3 . Define the tracking error 
vectors for the attitude and the angular velocity of the i-th 
quadrotor as 


Fig. 2. Stabilization of a rigid-body connected to multiple quadrotors 


e Ri 


\(Rl 


Ri - RjR ic y, e Qi = n, - RjR ic n ic , (34) 


controller on SO(3): 

fi A{ ' RiC^i 
Mi = - kRe r. - knen i 

+ (RfR Ci Cl Ci ) A 'J i RfR c 


(36) 


n Ci + JiRf R Ci n Ci , (37) 


and a configuration error function on SO(3) as follows 


*i = ^v[I 


R RA 


(35) 


The thrust magnitude is chosen as the length of Ui , projected 
on to —Rie 3 , and the control moment is chosen as a tracking 


where kR and kn are positive constants. 

Stability of the corresponding controlled systems for the 
full dynamic model can be studied by showing the the error 
due to the discrepancy between the desired direction 63 . 
and the actual direction Rie^. This stability is shown via 
a Lyapunov analysis. 












































































Proposition 3: Consider the full dynamic model de¬ 
fined by (fro}, {TT}, <|T2ji, <|T3 ]i. For the command xo d 
and the desired direction of the first body-fixed axis b\ i . 


control inputs for quadrotors are designed as (36) and 


(37). Then, the equilibrium of zero tracking errors for 

e x 0 , e Xo , e Ro , en 0 , e qij , e Uij , e Ri , e Qi , is exponentially 
stable. 

Proof: See Appendix |C| ■ 


V. NUMERICAL EXAMPLE 

We demonstrate the desirable properties of the proposed 
control system with numerical examples. Two cases are 
presented. At the first case, a payload is transported to a 
desired position from the ground. The second case considers 
stabilization of a payload with large initial attitude errors. 


A. Stabilization of the Rigid Body 

Consider four quadrotors (n = 4) connected via flexible 
cables to a rigid body payload. Initial conditions are chosen 
as 


zo(O) = [1.0, 4.8, 0.0] T m, v 0 (0) = 0 3x i, 

Qij( 0) = e 3 , Ldij(0 ) = 03 x 1 , Ri{ 0) = hx3, ^i(0) = 03 x 1 

^o(0) = ^3x3, ^0 = 03x1- 

The desired position of the payload is chosen as 

x 0d (t) = [0.44, 0.78, —0.5] t m. (38) 

The mass properties of quadrotors are chosen as 




(b) Side view 




(c) Top view 


nrii = 0.755 kg, 

Jt = diag[0.557, 0.557, 1.05] x 10“ 2 kgm 2 . (39) 


Fig. 3. Snapshots of controlled maneuver 


The payload is a box with mass mo = 0.5 kg, and its length, 
width, and height are 0.6, 0.8, and 0.2 m, respectively. Each 
cable connecting the rigid body to the i-th quadrotor is 
considered to be = 5 rigid links. All the links have the 
same mass of = 0.01kg and length of kj = 0.15 m. 
Each cable is attached to the following points of the payload 

pi = [0.3, -0.4, —0.1] T m, p 2 = [0.3, 0.4, -0.1] T m, 
p 3 = [-0.3, -0.4, -0.1] T m, p A = [-0.3, 0.4, -0.1] T m. 

Numerical simulation results are presented at Figure [2j 
which shows the position and velocity of the payload, and 
its tracking errors. We have also presented the link direction 
error defined as 

m rii 

e < 2 = XXll®i _e 3 H- 

i=l j=1 

B. Payload Stabilization with Large Initial Attitude Errors 

In the second case, we consider large initial errors for 
the attitude of the payload and quadrotors. Initially, the rigid 
body is tilted in its b\ axis by 30 degrees, and the initial 
direction of the links are chosen such that two cables are 


curved along the horizontal direction. The initial conditions 
are given by 

z o (0) = [2.4, 0.8, -1.0] T , v 0 (0) = 0 3x i, 

w ij(0) = 03x1, U,(0) = 03x1 

i? 0 (0) = i? x (30°), U o = 0 3x i, 

where i2 x (30°) denotes the rotation about the first axis by 
30°. The initial attitude of quadrotors are chosen as 

Ri(0)**Ry(-35°), R 2 (0) = 7 3x 3, 
i? 3 (0) = i4(-35°), R 4 (0)=I 3x3 . 

The properties of quadrotors and cables are identical to 
the previous case. The payload mass is m = 1.0 kg , and its 
length, width, and height are 1.0, 1.2, and 0.2 m, respectively. 

Figure [4] illustrates the tracking errors, and the total thrust 
of each quadrotor. Snapshots of the controlled maneuvers is 
also illustrated at Figure [5] It is shown that the proposed 
controller is able to stabilize the payload and cables at 
their desired configuration even from the large initial attitude 
errors. 






















(a) Payload position a?o:blue, xo d :red (b) Payload velocity uo:blue, uo d :red 




(c) Payload angular velocity flo (d) Quadrotors angular velocity errors 

e fii 




(e) Payload attitude error o (f) Quadrotors attitude errors ipi 



(a) t = 0 Sec. 


(b) t = 0.14 Sec. 


(c) t = 0.30 Sec. 



(d) t = 0.68 Sec. (e) t = 1.10 Sec. 



(f) t = 1.36 Sec. 



Fig. 5. Snapshots of the controlled maneuver. A short animation is also 
available at http://youtu.be/Mp4Riw6xB14 



(g) Quadrotors total thrust inputs f (h) Direction error e q , and angular ve¬ 
locity error e w for the links 


Substituting the derivatives of 0 and 0 into the above 
expression we have 


Fig. 4. Stabilization of a payload with multiple quadrotors connected with 
flexible cables. 


Appendix 

A. Proof for Proposition [7] 

1) Kinetic Energy: The kinetic energy of the whole sys¬ 
tem is composed of the kinetic energy of quadrotors, cables 
and the rigid body, as 

T =\rno\\x 0 \\ 2 + E J E J \rn i j\\x i j \\ 2 + § XZ 

i= 1J=1 *-1 

1 n 1 

+ — + 2 ^° * ^°^°* 
z i=i 


-| It I l/'i 

T = 2 777,0 ll®o II 2 + EE 2 m ij 11*0 + RoPi - E liaQia || 

i=l j =1 a=j +1 

-y n Hi 

+ - E m *lh° + ttoPi - TAagiall 2 

i=1 a= 1 

1 n x 

i — 1 " 


(40) 


(41) 














































































We expand the above expression as follow 

-j n rii n 

T =7 > ( m 0\\X0\\ 2 + 


3) Derivatives of Lagrangian: We develop the equation 
of motion for the Lagrangian L = T — V. The derivatives 
of the Lagrangian are given by 


i =1 3 = 1 


i= 1 


+ \^^rn ij \\R,p£ +m i \\R 0Pi f) 

1=1 j = 1 
n rii 

+ E(E rriijX o • R 0 pi + mix 0 • RoPi) 

i =1 3=1 

1 n Ui _ Ui _ Ui _ 

+ 2 ECE^ill E ^a%a|| 2 +m i ||E i ia4ia|| 2 ) 

i =1 j = l a=7 + 1 a=l 

n rii ni ni 

-E(E TflijX o * ^ ^ liaQia H" To E liaQia) 

i =1 j=l a=j + l a=l 

n rii ni ni 

^ TYljjRoPi ' ^ ^ liaQia H" TfliR^Pi ’ ^ ^ 

2=1 j=l <2=7 + 1 a=l 


D± 0 L = M iT Ropi — EE Mq ij lij Qjj , 

2=1 J = 1 


2 = 1 


D Xq L = M T ge 3 , 


(47) 

(48) 


_ EE -M-Oij likQik ^ ^ M-Qjj Ijj (Tq -RoPi)} 

2=1 J = 1 2=1 

(49) 


79 'q i: j L — ^ ^ Moij lij e 3 , 


(50) 


2=1 


where D Xo denote the derivative with respect to To, and other 
derivatives are defined similarly. We also have 


(42) 


1 x-Ev 1 

+ 2 ^ ^ ^2i ’ Ji^i “T * Jof^o, 

Z 2=1 

and substituting ( p~4]) , ( p~5] ), it is rewritten as 

^ 1 n n 

T =-M t ||T 0 || 2 + - E ^^H^oPill 2 + y^(M ?:T ± 0 • 77oPi) 


79q 0 L = TqU 0 + E M iT piR 0 


iT • 

^ 0 , 


2=1 


-EE MoijlijPiRft Qij ^MiTfiClo, (51) 

2 = 1 J = 1 


2=1 


2=1 


n rii 


+ E E MoijlikQij * Qik ^ ^ (Tp ' ^ ^ MpjjljjQjj ) 

2=1 J, /c = 1 2=1 J = 1 

n rii 

- ^{Ropi ■ E Moij lij Qij ) 

2=1 J=1 


Dq 0 L — ToUq "T ^ ^ PiRp (M-iTX 0 ^ ^ -^oijhjQij )? 

3 =1 

(52) 


2=1 


1 n x 

— ^ ^ f^i • JiDi T" ’ T 0 U 0 . 


(43) 


Dfi i L — ^ ^ Ji^li, 

2 = 1 

where Jo is defined as 


2=1 


2) Potential Energy: We can derive the potential energy 
expression by considering the gravitational forces on each 
part of system as given 


To = To — E M iT Pi . 


(53) 


(54) 


2=1 


The derivation of the Lagrangian with respect to i?o is given 
by 


V = -m 0 ge 3 • x 0 - E m^e 3 • - EE mijgez 

2=1 j=i 


2=1 


Dr 0 L • ERq = ]E MirRoVo&opi • To 


(44) 


2=1 


Using 0 and ([5]), we obtain 

n rii 

V = - m 0 ge 3 • #o - E m ^ es * ( x ° + 77o/>2 - E li> 


^ ^ RoPO&OPi ’ ^ ^ ETq ijlijQij 
3 = 1 


2 = 1 


a=l 


-EE mijge 3 ■ (z 0 + ^ haQia), (45) 

2=1 j = l a=J + l 

and utilizing ( p~5] ), we can simplify the potential energy as 


V — —M T ges • xo — M iT ge 3 • RoPi + EE M 0ij lij Qij 

2=1 2=1 i=i 

( 46 ) 


2=1 

n 

+ E MiTge 3 * RoVoPi: (55) 

which can be rewritten as 

Z9r 0 L • ER 0 = Tr 0 • 770 , (56) 

where 

n rii 

, T/7 0 = ^^(((UoPi-Ro (MiT% 0 ) ^ ^ Mpjj Ijj Qjj ) 

2=1 J=1 

+ MiTgpiR^ef)). (57) 


4) Lagrange-d'Alembert Principle: Consider 0 = J** L 
be the action integral. Using the equations derived in previous 
section, the infinitesimal variation of the action integral can 
be written as 

r l f 

SQ5 — / DxqL - dx 3 H- D Xq - Sxq 

41 0 

+ Dq 0 L(t]o + U 0 x rjo) + 4 r q L - 770 

n rii 

+ EE^ L(iij x qij + ij x qij) 
i= 1 3 = 1 
n rii 

+ ^ D qij L • x ) 
i=l j=l 

n 

+ • (% + flt x Vi)- (58) 

2=1 

The total thrust at the i-th quadrotor with respect to the 
inertial frame is denoted by ui = —fiRiC 3 G M 3 and the 
total moment at the i-th quadrotor is defined as Mj G l 3 . 
The corresponding virtual work is given by 

pt f TLi 

8W = I y ^ Uj • {&Eo “I - R 0 V 0 Pi y ^ Ijjjij x g^jf} 

^ to 2—i i=i 

+ Mi - rfr dt. (59) 


According to Lagrange-d Alembert principle, we have £0 = 
—SW for any variation of trajectories with fixes end points. 
By using integration by parts and rearranging, we obtain the 
following Euler-Lagrange equations 


d 


dt^xiL DxpL — 1 


2—1 


j t D Qo f^ox Dq 0 - 4r 0 = 


i=i 


d 


Qij (jq-DqijL qijD Qi L — lijqijUi , 

—DqL + ^2 x Dq L = Mi. 
dt 


(60) 

(61) 

(62) 

(63) 


Substituting the derivatives of Lagrangians into the above 
expression and rearranging, the equations of motion are given 
by {n), 

#. Proof for Proposition [2] 

The variations of x and q are given by ( [24] ) and ( [25] ). From 
the kinematics equation q^ = ujij x q i3 and 

= iij x e 3 = 5 uij x e 3 + 0 x (fij x e 3 ) = 5 u>ij x e 3 . 


Since both sides of the above equation is perpendicular to 
e 3 , this is equivalent to e 3 x (£^- x e 3 ) = e 3 x (( 5 cc^ x e 3 ), 
which yields 

67 — (e 3 • iij)e 3 = — (e 3 • &u*j)e 3 . 

Since • e 3 = 0, we have ^ • e 3 = 0. As e 3 • £047 = 0 
from the constraint, we obtain the linearized equation for the 
kinematics equation of the link 

(64) 


The infinitesimal variation of Rq G SO(3) in terms of the 
exponential map 


5Rq — 


de 


Rq exp(e?)o) = RoVo, 


(65) 


e=0 


for 770 • Substituting these into ([10]), ( |11| ), and ([12]), and 

ignoring the higher order terms, we obtain the following sets 
of linearized equations of motion 


MrSx 0 — y ^ M iT piSn 0 




EE Moi j l ij e 3 C(C T £ij ) = ^ Su t (66) 

»=i 3 =1 


2 — 1 


E MiTPifixo + JoStlo + E E M(Rj lij pi e 3 C (C '(ij ) 

2-1 j=i 


2—1 


+ V —gpie 3 po = Y Pi Su * (67) 

“ rc — 

2=1 2=1 

rii 

-MoijC T e 3 5xo + M(RjC T e 3 pi5&o + Moijhkd 2 {C T iij) 


k=l 


= -C T e 3 Sui + (-M iT - ^ + M 0 ij)ge 3 I 2 {C T Zij) 


fji — 7)0 — JidLli — 5Mi, 


( 68 ) 

(69) 


which can be written in a matrix form as presented in (26). 
See [18] for detaied derivations for a similar dynamic system. 
We used C T e^C = — I 2 to simplify these derivations. 


C. Proof for Proposition [3] 

We first show stability of the rotational dynamics of each 
quadrotor, and later it is combined with the stability analysis 
for the remaining parts. 

1) Attitude Error Dynamics: Here, attitude error dynam¬ 
ics for eR i , CQ i are derived and we find conditions on control 
parameters to guarantee the boundedness of attitude tracking 
errors. The time-derivative of JiCQ i can be written as 

Jitsii = {JiCQi + d i } A eQ i - k R e Ri — (70) 

where di = (2 R — tr [Ji\I)Rf Ri d Qi d G M 3 [14]. The 
important property is that the first term of the right hand side 
is normal to e^., and it simplifies the subsequent Lyapunov 
analysis. 

2) Stability for Attitude Dynamics: Define a configuration 
error function on SO(3) as follows 

*i = ltr [I-RjRi]. (71) 

We introduce the following Lyapunov function 

n 

V 2 = ]Tv 2i , (72) 

2=1 

where 

V 2i = -en i -JieQt + kR^itRi, Rdi) + c 2i eRi -e^. (73) 


£\ij — SbJij. 







Consider a domain D 2 given by 

D 2 = {(-Ri,fii) eSO(3) xM. 3 \^i{Ri,R di ) < ^ < 2}. 

(74) 

In this domain we can show that V 2 is bounded as fol¬ 
lows [14] 


zlM i21 z 2i < V 2i < ziM i22 z 2i , 


(75) 


and z 2i = [||e fi J, ||enJ] T e K 2 . Matrices M* 21 , M i22 are 

given by 


Mi 21 — ^ 


^22 2 


k R —C 2i \Mi 

— C 2i ^Mi ^mi 

C2i X Mi A Mi 


v 2 <-y^ 2i , 

7=1 

where the matrix W 2i G M 2x2 is given by 

C2, 


(76) 


W 2s = 


^ 2 ^ k R — ^ (kn + B 2 .) 

— + 5 2 .) fcfi - 2c 2i \Mi 


The matrix IU 2i is a positive definite matrix if 

y/k R \ 

rrii 


c 2i < min{ - 


A Mi ’ SkuXMi + (Mi + 7?i 2 ) 2 


}■ (77) 


This implies that 

n 

V2<-Y, X m(W2 i )\\z2 t f, 




Mx + Gx = B (u — u*) + 0 (x, x), 


(79) 


where 



~u{ 


~~{M 1T + ^)ge 3 ' 


U2 


— (M 2 t + 

u = 

_Rn_ 

, U* = 

_-(M nT + v yf)ge 3 _ 


( 80 ) 


and g(x, x) corresponds to the higher order terms. As Ui = 
—fiRie 3 for the full dynamic model, Su = u — u* is given 
by 


Su = 


-f lRl e 3 + (M 1T + ^)ge 3 
—/ 2 i? 2 e 3 + (M 2T + n zr)ge 3 


(81) 


— fnRnZ 3 + (M nT + II ^-)ge 3_ 

The subsequent analyses are developed in the domain Di 


The time derivative of V 2 along the solution of the controlled 
system is given by 


Di = {(x, x, Ri , e^.) G M Dx x M Dx x SO(3) x M 3 | 


V 2 = ^ — fe|||| 2 + c 2i e^ • + c^e#. • Jp^.. 

7=1 

Substituting ( |70| ), the above equation becomes 

n 

V 2 = ^ — telle^ || 2 + c 2i e Ri • — c^fc^He^. || 2 

7=1 

+ c 2i ei?. • (( Jien i + di) A e^. - fee^.). 

We have ||e^ || < 1, p#. || < p^. || [19], and choose a 
constant B 2 . such that \\di\\ < B i2 . Then we have 


^7 < ipu < 1 }. 

In the domain D\, we can show that 

l\\e Ri \\ 2 <^i(Ri,R Ci )< 1 


2 — V’li 




(82) 


(83) 


Consider the quantity e 3 R^.Rie 3 , which represents the co¬ 
sine of the angle between b 3i = Rie 3 and b 3c . = R Ci e 3 . 
Since 1 — \E^(it^, i? c .) represents the cosine of the eigen-axis 
rotation angle between R c . and Ri , we have e 3 R^Re 3 > 
l — ^i(Ri 1 R c .) > 0 in D\. Therefore, the quantity 1 

Ii 


is well-defined. We add and subtract 


right hand side of ( [81] ) to obtain 

—fi 


Su = 


eTRT iRie 3 ^ C1 


R Cl e 3 — Xi 


eTRT'Rie 3 

( Mit + n ^ L )ge 3 


e^R^.Rie 3 

i? c e 3 to the 




~fn 

Rn&3 


Rc n es ~ X n + (M nT + r yf)ge 3 


(84) 


where 2 Q G M 3 is defined by 

u„Tt>T 


Xi = 


e T 3 RlRie 3 


((e 3 R 1 Rie 3 )Rie 3 - R Ci e 3 ). (85) 


Using 


(78) - 


e£RlRie 3 


which shows stability of the attitude dynamics of quadrotors. 

3) Error Dynamics of the Payload and Links: We derive 
the tracking error dynamics and a Lyapunov function for 
the translational dynamics of a payload and the dynamics 
of links. Later it is combined with the stability analyses of 
the rotational dynamics. From ( fT0| ), ( [26] ), ( [3l] ), and ( [36] ), the 
equation of motion for the controlled dynamic model is given 
by 


t-> _ (IPi ||7^Ci e 3) ' Ri e 3 Xi _ 

C<3 ^ ep^e 3 ' Mil '■ 

( 86 ) 


the equation (84) becomes 


Su = 


■A 1 -X 1 + {M 1T +**)ge 3 
A 2 -X 2 + (M 2T + ^)ge 3 


(87) 


An -X n + (M„t + )ge 3 _ 

Substituting ( f3l] > into the above equation, ( |79l > becomes 
Mx + Gx = B(—iT x x — iT^x — X ) + jj(x, x), ( 88 ) 

































where X = [Xf, Xf , • • • , Xf ] T G M 3n . It is rewritten in 
the following matrix form 

z\ = Azi + B(BX + g(x, x)), (89) 

where z\ — [x, x] T G R 2Dx and 

A _f o / 

[—M -1 (G + BA X ) -M'B K x 

(90) 


,B = 


0 

M” 1 


We find an upper boundary for 

A = -K x x - K x ± + u*, (99) 

by defining 


IK II < B u , (100) 

for a given positive constant Pi. defining X ma;E G M 
A~max — nmx{ K x \\, ll^xll}, 


We can also choose K x and A' x such that A e ^ 2 D x x 2 D x 
is Hurwitz. Then for any positive definite matrix Q G 
^ 2 D x x 2 D x , th ere exist a positive definite and symmetric 
matrix P G ]^ 2D ^ x2D ^ such that A T P + PA = — Q 
according to [20, Thm 3.6]. 

4) Lyapunov Candidate for Simplified Dynamics: From 
the linearized control system developed at section 3, we use 
matrix P to introduce the following Lyapunov candidate for 
translational dynamics 

Vi = zfPzi. (91) 

The time derivative of the Lyapunov function using the 
Leibniz integral rule is given by 

Vi = if Pzi + z\Pz \. (92) 

Substituting ([89]) into above expression 

Vi = z[ (A T P + PA)z 1 + 2 z\ PB(BX + fl (x,x)). (93) 

Let C 3 = 21|P’BB ||2 £ K and using A T P + PA = —Q, we 
have 

Vr < -zfQzi + C3\\z 1 \\\\X\\ + 2zfPBQ(x,x)- (94) 

The second term on the right hand side of the above equation 
corresponds to the effects of the attitude tracking error on 
the translational dynamics. We find a bound of X^, defined 
at ( [85] ), to show stability of the coupled translational dy¬ 
namics and rotational dynamics in the subsequent Lyapunov 
analysis. Since 

ft = \\A\\(elRlRie 3 ), (95) 

we have 


and then the upper bound of A is given by 

Pill < #max(||x|| + ||x||) + Bi 

< 2PtT max || 2 : 1 1| + B\. 


( 101 ) 


Using the above steps we can show that 

n 

||X|| <^((2^11^+51)1^1 

i= 1 

< (2AT max ||2i|| + Bi)a, 


( 102 ) 


where a = a i- Then, we can simplify (94) as 

Vi < - (A mi „(Q) - 2c 3 K max a)\\z 1 \\ 2 

n 

+ y^c 3 Pi|| 2 :i||||e fli || + 2zfPBfl(x,x). (103) 


i=1 


5) Lyapunov Candidate for the Complete System: Let 
V = Vi + V 2 be the Lyapunov function for the complete 
system. The time derivative of V is given by 


V = Vi+V 2 . 


(104) 


Substituting ( |103| ) and ( [78] ) into the above equation 

V < - (A mi „(<2) - 2c 3 K max cx) \\z± || 2 + 2z'[PBg(x,x) 

n n 

+ Y, C 3^1 INI \\ e Ri II - E NNNN II 2 , (105) 

i= 1 i=1 

and using He^. || < \\z 2 i ||, it can be written as 

V< (^min (Q) - 2c 3 K max a)\\z 1 \\ 2 + 2zf PBg(x,x) 

n n 

A m (W 2 ,) \\z 2i || 2 . (106) 

2=1 2=1 


||Aj|| < ||Ai||||(e 3 i?g.i?je 3 )i?je 3 — i? Ci e 3 ||. (96) 

The last term ||(e 3 P^Pje 3 )P,e 3 — P Ci e 3 1| represents the 
sine of the angle between b 3i = P^e 3 and 63 c . = R Ci e 3 , 
since (b 3c . -b 3i )b 3i -b 3ci = b 3i x (63. x b 3c . ). The magnitude 
of the attitude error vector, \\eR.\\ represents the sine of the 
eigen-axis rotation angle between R Ci and P^. Therefore, 


; R Ci ^i e s)Ri e 3 ~ RcX 3II 
;PfP*e 3 )P*e 3 - R Ci e 3 \ 


< ||e#. || in Pi. It follows that 

< \\ e Ri II = v / T , j(2 — \l/j) 

< {PkX-Xu) = oti} < 1 , 

(97) 


The 2zJ PBg(x, x) term in the above equation is indefinite. 
The function g(x, x) satisfies 

IIsOl x )II 


INI 


—y 0 as ||^i|| —y 0 . 


Then, for any 7 > 0 there exists r > 0 such that 

llfl(x,x)|| < 7IINI Vll^ill <r. 

Therfore 


2zfPB q(x, x) < 27||P|| 2 ||2:i|| 2 . (107) 

Substituting the above inequality into < |106| > 

V < - (A m in(Q) - 2c 3 K max a)\\z 1 \\ 2 + 2 7 ||P|| 2 ||z 1 || 2 

n n 

A m (W 2l )lk2,|| 2 , (108) 

2=1 2=1 


therefore 


W <11^111^11 

< ||^i||Q!i. 


(98) 










and rearranging 

y ^ ^^^min(Q) 2C3i^ max a ^ ^ 


i=l 


C3Bi|| 2l ||||^||+A m (W 2i )||^|| 2 ) 

■27l|P|| 2 |ki|| 2 , (109) 


we obtain 


V < - J2^ W ^ + 2 ^ll P ll2lNlH 2 > (110) 




where z* = [||zi||, \\z 2i 


and 


W z = 


A m in(Q)-2c 3 K max Q C 3 B lj 

-^r 1 A m (W- 2< ) 


By using ||zi|| < ||zj||, we obtain 

X^(\ mn ^ll-^ll 2 \|i ip 

V < 2^(A m i n (rv») n )ll z i|l • 

Choosing 7 < n(A min (W»))/2||P|| 2 , and 

n||^|| 2 


A m (W 2i ) > 


^min (Q) 2C3^ max Q( 


( 111 ) 


( 112 ) 


(113) 
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ensures that V is negative definite. Then, the zero equilibrium 
is exponentially stable. 


References 

[1] L. Cicolani, G. Kanning, and R. Synnestvedt, “Simulation of the 
dynamics of helicopter slung load systems,” Journal of the American 
Helicopter Society, vol. 40, no. 4, pp. 44-61, 1995. 

[2] M. Bernard, “Generic slung load transportation system using small 
size helicopters,” in Proceedings of the International Conference on 
Robotics and Automation, 2009, pp. 3258-3264. 

[3] I. Palunko, P. Cruz, and R. Fierro, “Agile load transportation,” IEEE 
Robotics and Automation Magazine, vol. 19, no. 3, pp. 69-79, 2012. 

[4] N. Michael, J. Fink, and V. Kumar, “Cooperative manipulation and 
transportation with aerial robots,” Autonomous Robots, vol. 30, pp. 
73-86, 2011. 

[5] I. Maza, K. Kondak, M. Bernard, and A. Ollero, “Multi-UAV cooper¬ 
ation and control for load transportation and deployment,” Journal of 
Intelligent and Robotic Systems, vol. 57, pp. 417-449, 2010. 

[6] D. Zameroski, G. Starr, J. Wood, and R. Lumia, “Rapid swing-free 
transport of nonlinear payloads using dynamic programming,” Journal 
of Dynamic Systems, Measurement, and Control, vol. 130, no. 4, p. 
041001, June 2008. 

[7] J. Schultz and T. Murphey, “Trajectory generation for underactuated 
control of a suspended mass,” in IEEE International Conference on 
Robotics and Automation, May 2012, pp. 123-129. 

[8] I. Palunko, R. Fierro, and P. Cruz, “Trajectory generation for swing- 
free maneuvers of a quadrotor with suspended payload: A dy¬ 
namic programming approach,” in IEEE International Conference on 
Robotics and Automation, RiverCentre, Saint Paul, Minnesota, USA, 
May 14-18 2012. 

[9] T. Lee, K. Sreenath, and V. Kumar, “Geometric control of cooperating 
multiple quadrotor UAVs with a suspended load,” in Proceedings of 
the IEEE Conference on Decision and Control, 2013, accepted. 

[10] F. Goodarzi, D. Lee, and T. Lee, “Geometric stabilization of quadrotor 
uav with a payload connected by flexible cable,” in Proceedings of 
American Control Conference, 2014, pp. 4925-4930. 

[11] T. Lee, “Geometric control of multiple quadrotor UAVs transporting 
a cable-suspended rigid body,” March 2014. [Online]. Available: 
http://arxiv.Org/pdf/l 403.3684v2.pdf 

[12] T. Lee, M. Leok, and N. McClamroch, “Geometric tracking control of 
a quadrotor UAV on SE(3),” in Proceedings of the IEEE Conference 
on Decision and Control, 2010, pp. 5420-5425. 











